#ifndef __MPU6050_H__
#define __MPU6050_H__
#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>
#include <Arduino.h>
#include "kalman.h"
void mpu_init();
void mpu_test(int mode );
// void get_acc_kf();

void print_gyro_kf();
void get_acc_gyro_anlge_kf(float &gx,float &gy ,float &gz,float &ax,float &ay,float &az);
void print_acc_raw();
void print_gyro_raw();
void print_acc_kf();

#endif 